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Quadrotor is one of rotary wing UAY types which is able to perform a hover 
position. In order to take off, landing, and hover, it needs controllers. 
Conventional controllers have been widely applied in quadrotor, yet they 
have drawbacks namely overshoot. This paper presents attitude and altitude 
control algorithm in order to obtain a response as quadrotor hovered 
optimally within minimum overshoot, rise time, and settling time. The 
algorithm used is Fuzzy Logic Controller (FLC) algorithm with Mamdani 
method. By using the algorithm, the quadrotor is able to hover with 
minimum overshoot and maximum rise time. The advantage of the algorithm 
is that it does not require linearization model of the quadrotor. 
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1. INTRODUCTION 

Quadrotor is basically unstable because it is a non-linear model that has many variables with 6 
degrees of freedom affected by four actuators. Previous researchers created quadrotor models in dynamics 
and kinematics represented in two models, namely nonlinear and linear. Quadrotor modeling needs some 
consideration, namely solid frames, rotor placement on each angle having symmetrical distance, and the 
position of the center of gravity (COG) is right at the midpoint of the crossing frame arm. Euler-Lagrange 
and Newton-Euler methods are generally used in aircraft modeling, however, Newton-Euler is more widely 
used because it is more easily understood. 

Researches on quadrotor have been widely conducted by previous researchers in the field of control 
by using conventional traditional controls as practiced by Bouabdallah et al [1] using the configuration Plus 
for microquadrotor OS4 model weighing 240 grams controlled by PID and LQR control methods by referring 
to six states of roll, pitch, and yaw based attitude. In designing PID control of non-linear model of quadrotor 
obtained from the dynamics and kinematics, it is firstly linearized to obtain a state variable in that the 
stability can be identified. 

Quadrotor modeling has been successfully developed by Bouabdallah & Siegwart [2] by modeling 
quadrotor from 6 to 12 states. In addition they modify backstepping algorithm by adding integral then called 
integral-backstepping. The algorithm is used to control the attitude and altitude, so that it can take off and 
landing autonomously. The algorithm is also used to control the position of the quadrotor in order to perform 
fly autonomously and avoid obstacles. With the algorithm, there is no overshoot when it hovers at the desired 
height but it takes a long raise time. 

One of the criteria for good performance in the control of hover is a quick or minimum response. 
However, the rapid response tends to cause oscillation and requires a fairly large control signaling. It can be 
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said that in the transient state, the use of signal control tend to be less good and less stable. To achieve good 
performance, there are several other researchers who combine conventional algorithm with artificial 
intelligence as conducted by Kirli et al [3] applying fuzzy algorithm to change the PID parameters on 
quadrotor control. Moreover, some researchers such as Gao et al [4] have conducted a study combining the 
PD algorithm with Fuzzy. It can be seen from the experiment results that the quadrotor can hover at the 
desired height without overshooting but still takes a long raise time. 

Modern conventional control such as backstepping algorithm combined with fuzzy algorithm by 
Basri et al [5] for roll, pitch, yaw, and altitude control of quadrotor. Backsteeping control is optimized by 
changing the parameter values in the algorithm. The process of changing the parameters of backstepping 
takes a considerable time, so that to accelerate the process requires adaptive artificial intelligence algorithms 
such as fuzzy logic. The other modern control algorithms such as slidding mode algorithm combined with 
fuzzy algorithm by Barghandan & Badamchizadeh [6] to control the quadrotor attitude. The fuzzy algorithm 
is used to change the parameter values contained in slidding mode control, so that the control is more 
optimal. 

Furthermore, adaptive artificial intelligence control has been applied to quadrotor as practiced by 
Zangenehpour et al [7] applying fuzzy logic algorithm for controlling the speed of the motor on the 
quadrotor. Fuzzy algorithm has been applied to the PIC microcontroller with inputs of angle and motor speed 
and output of motor pulse with the basic rules of 5x5. The result of the experiment showed that the fuzzy can 
be used to control a motor on quadrotor. The other researchers named Santos et al [8] have applied fuzzy 
logic control with mamdani method to control the x, y, and z positions in quadrotor. This algorithm is used 
and modified for membership output members with 5 members to control the positions of x, y, and z in 
quadrotor in an undisturbanced environment. In the control system carried out, quadrotor modelling in 
dynamic and kinematic has not been conducted. The quadrotor is modeled by using aggregation block that is 
a connected block between the controller and the dynamic system functioned to implement the connection of 
the control action of the four controllers. 

In addition, Varga & Bogdan [9] have applied fuzzy-Fyapunov to control the positions of x, y, and z 
in quadrotor. There are six fuzzy controls used to control the quadrotor namely x-axis, y-axis, z-axis and yaw 
fuzzy controls. The two inputs namely altitude error and altitude change rate are used for z-axis control. A 
nonlinear quadrotor modeling is needed to determine the stability of the quadrotor by using Fyapunov 
method. The simulation result shows that there are still long overshoot and rise time. The other researchers 
such as Fakurian et al. [10] have modified the fuzzy input sets with triangular and gaussian type’s 
fuzzyfication. By using the algorithm, quadrotor can hover at a pre-determined height in the undisturbances 
environment. 

Based on the previous researches, on the altitude and attitude using artificial intelligence control, it 
can be seen that quadrotor can hover at the pre-determined height, but there are still overshoot, oscillation 
and a long raise time. Quadrotor cannot cope with disruptions of vertical wind because it is merely tested 
indoor. To overcome these problems, a strategy or method of intelligent control algorithms are needed to 
obtain the system with minimum overshoot and settling time and to generate output response with a good 
performance and stable in a transient state. 


2. QUADROTOR 
2.1. Quadrotor Modeling 

Quadrotor has 6 degrees of freedom, namely three translational motions and three rotational 
motions. The dynamic motion model of the quadrotor is represented in force and torque generated from the 
rotors. The configuration of the quadrotor based on Corke’s models [11] is shown in Figure 1 with the z-axis 
direction point down results in a negative value. The position of the quadrotor for \x y z\ T are symbols as 
x-axis, y-axis and z-axis, for |0 0 ^| r are symbols as roll angle, pitch, yaw, for \uvw\ T are symbols as 
speed caused by the x-axis, y-axis, z-axis, and for \p q r\ T are symbols as angular speed caused by the x-axis, 
y-axis, z-axis. 

Figure 1 shows that the global framework f g with coordinates (x g , y g , z g ) is used as a quadrotor 
reference framework unmoved from the system. The quadrotor framework f q with coordinates (x q , y q , z q ) has 
4 rotor at the end of his cross-arm, each rotor consists of two pairs of rotor having a directional rotating 
motion. Rotors 1 and 3 rotate clockwise, whereas rotors 2 and 4 rotate counter-clockwise respectively. Each 
propeller produces force [F x ; F 2 ; F 3 ; F 4 ] r ; all have the same direction and the total force in quadrotor 
(excluding gravity) as follows [F x ; F y ; F Z ] T . This force produces a moment around the axis of the quadrotor 
written as follows [ M x ; M y ; M Z ] T . 
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Figure 1. Quadcopter Configuration 


There are three transformations of quadrotor’s Euler angles when the quadrotor frame of f q rotates 
towards the z q axis (yaw) has a rotational transformation of Euler angles R z (\|/), the quadrotor frame of f q 
rotates towards the y q axis (pitch) has the rotational transformation of Euler angles R y (0), and the quadrotor 
frame of f q rotates towards x q axis (roll) has rotational transformation of Euler angle R (x, ([)). The 
transformation matrix of each of the x-axis, y-axis and z-axis can be formulated as follows: 
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The transformation matrix R generated is as follows: 
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Where c = cosine and s=sine. By using the transformation matrix R provided above, the linear 
velocity along the axis of the body can be transformed into inertial frame. Vector [x; y; z] T defines the 
quadrotor position relative to the inertial frame and [u; v; w] T defines a linear velocity of the quadrotor 
within the framework of the rigid body. Equation (3) states the relationship that exists between the two 
vectors. 
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Angular velocity along the axis of the quadrotor body can be transformed into Euler speed using the 
transformation matrix W provided in the following equation 
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There are four forces served as quadrotor dynamics influenced by the thrust constant relative to the 
air density (b), the distance between the motor with the center point of mass of the quadrotor (d), and the 
slidding constant. The relationship between force and a rotational speed of the rotor can be represented in the 


following equation: 

1. Vertical Force 
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2. Moment of roll force 
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3. Moment of pitch force 
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4. Moment of yaw force 

r z = kfal — col + col — ) (9) 


The translational dynamics of the quadrotor comparable to the influence of the Coriolis force is 
determined based on the second law of Newton [12] that is as follows: 


F = ma 

which m = quadrotor mass (kg), a = acceleration (m/s 2 )and F is the force generated by quadrotor where 
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From these equations, the acceleration of the body can be seek by the following equation: 
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Thus, the rate speed of the linear body can be calculated as: 
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u = —T.cos^.siriQ.cos^ — T.sin^.sin^ — qw + rv 
v = —T. Cos^.SiriQ.Sin^ + g. SinCos^ —ru + pw 
w = g — T. Cos^Cosq — pv + qu 

Based on the Newton's second law of rotational motion [12], the following equation is obtained 

M = \d) + (m x 7m), (13) 

which a) = \P Q r |, M = [M x M y M Z ] T and I is the moment of quadrotor inertia. 
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The result of the substitution of equations 13 and 14 can be written as follows: 
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The equation of the angular acceleration in the x, y, and z axes are as follows: 
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Several previous researchers assume that the Coriolis Effect [13] is very small that it can be. So that 
the representation of the 12 nonlinear state equations of the quadrotor system models is as the folllowing 
equations: 
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2.2. Quadrotor Controller 

Closed-loop control strategy is needed precisely because of the quadrotor dynamics. In this section, 
a model of state space quadrotor is presented for controller design. Representation of 12 non-linear state 
equations is used to develop equations of state space of the quadrotor which is multi-input multi-output 

system (MIMO) defined as x = [x, y, z, 0, 6, xjj, u, v, w, p, q, r] . The state variable components 
defined as x = [x, y, z, 0, 6, 0, u, v, w, p, q, r] T and the control input vector components defined as 
U= [T T x T y T z ] T . 

These components will be afterwards used in meeting the state space equation: 
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There are two controls studied by several previous researchers that is controls of altitude and 
attitude [2]. They have been used to control the speed of the four motor rotation with the same speed [14]. It 
can be seen in equations 10 and 13 that the rotational and the translational motions are unconnected as shown 
in Figure 2. 



Figure 2. Diagram block of quadrotor 


Figure 2 shows that four controls are required for the quadrotor consisting of the altitude of ( T ) for 
subsystem translational and attitude of (t x , T y , r z ) for subsystem Rotational in which the outputs of the 
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subsystem are roll, pitch and yaw used for subsystem translational. Thus, the closed-loop control can be 
designed for the attitude and altitude. 










D '• 

< 5 \ 


Figure 3. Block Diagram of (A) altitude and (B) attitude control 


2.3. Altitude Control 

Altitude control is required to ensure that the quadrotor is at a secure altitude [15]-[18]. So that it is 
also responsible for restoring the quadrotor to a secure state at a certain altitude if it performs impaired 
position due to air turbulence. The altitude control input of the quadrotor shown in figure 2 is thrust (T) 
which is the multiplication of relative thrust constant to air density (b) with the sum of four motors as written 
in equation 6. Several algorithms have been studied and applied to quadrotor altitude by previous researchers, 
for example, the PID algorithm investigated by Lee et al. [19], the slidding mode algorithm studied by 
Gonzalez et al. [20], the model predicting control (MPC) algorithm investigated by Alexis et al. [21]. From 
the previous studies, the researchers have used two inputs to design the control block for altitude in quadrotor 
as in Figure 3(A). 

In Figure 3(A), it appears that to control the altitude two inputs namely error and error change rate 
are required. Error value of ( e ) obtained from the difference between the set point with the actual height (z), 
can be expressed as in the following equation: 

e = z — Sp z (31) 

Where z is the height value of the quadrotor. The height value of this quadrotor is negative because 
quadrotor is against the earth gravity. While Sp z is the value to the desired height. It has a positive value so 
that the error algorithm of equation (31) is modified into the following equation: 

e = z - (-Sp z ) (32) 

2.4. Attitude Control 

Attitude control is required to stabilize the quadrotor while it hovers. This control is responsible for 
ensuring that the angles of roll, pitch and yaw on quadrotor have a minimum value by controlling the four 
motors rotates at the same speed, so that it can hover stably. The previous researchers have used a variety of 
algorithms to control attitude such as the PID algorithm used by Lee et al. [19], the Sliding Mode Control 
algorithm used by Bouadi et al. [22], and the backstepping algorithm used by Colorado et al. [23]. In the 
previous studies, the researchers have used a six inputs and three outputs to design a control block for attitude 
in quadrotor as in Figure 3(B). 

It can be seen in figure 3(B) that three controllers are required for attitude namely roll, pitch control 
and yaw controls in which each control has two inputs and an output. Roll control has a thrust output and two 
inputs of roll error (e 0 ), and the change rate of roll ( 9 ). Roll error value obtained from the difference between 
the set point with the actual roll angle (0), can be expressed as in the following equation: 

e = 0-Sp e (33) 

6 is the value of the roll angle of the quadrotor, and Sp e is the desired roll angle value in which the 
roll angle is 0 for the quadrotor to be stable. Pitch control has a thrust pitch output and two inputs namely 
pitch error ( e ^) and change rate of pitch (0). Pitch error value obtained from the difference between the set 
point with the actual pitch angle (0), can be expressed as in the following equation: 

e = 0 - (34) 
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<p is the value of the pitch angle of the quadrotor, Sp$ is the desired picth angle value in which the 
pitch angle is 0 for the quadrotor to be stable. Yaw control has a yaw thrust output and two inputs namely 
yaw error (e^) and change rate of yaw ( i [)). Yaw error value obtained from the difference between the set 
point with the actual roll angle ( i/j ), can be expressed as in the following equation: 


e = i/j-Sp lp , (35) 

where x/j is the value of the yaw angle of the quadrotor, Sp ^ is the desired yaw angle value in which the yaw 
angle is 0 for the quadrotor to be stable. 


3. CONTROL STRATEGY 

This study will discuss the hover control system for quadrotor at a desired altitude. Altitude and 
attitude controls are used to maintain the stability of the quadrotor. Fuzzy logic algorithm is one of the 
artificial intelligence algorithms to control the altitude and attitude by using Mamdani methods [24]-[26]. 

3.1. Altitude Stability 

Figure 3(A) shows that the altitude control has two inputs namely error and the error change rate. 
This control has also an output that is used as a throtel thrust input to control the rotation of the four motors 
on the quadrotor. In this paper, the proposed control is fuzzy logic algorithm which is multi input single 
output (MISO) consisting two inputs and an output. Further, the fuzzy control system for controlling the 
height of the quadrotor shown in the block diagram in Figure 4 is developed. It shows that this control has 
two inputs and an output. The inputs and outputs are used to design the fuzzy logic control as members of the 
fuzzy set. 





Figure 4. The proposed altitude control system 


The altitude control design using fuzzy logic algorithm proposed in this paper. This algorithm is 
fuzzy MISO which has two inputs and an output using mamdani method as the basic rules. The inputs and 
output are designed to have three membership functions contained in the universal sets. The universal sets 
have different range values for input error, input error change rate and output. There are minimum and 
maximum values for the universal sets range of the input error which can be determimed by using equation 
2.50. the universal sets of input error ranging [-11] has three membership functions shown in Figure 5(A). In 
the figure, it can be seen that membership functionss consist of NS (negative small), Z (zero), and PS 
(positive small). 




Figure 5. (A) Error and (B) Dz variable input design 
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In this paper, the minimum and maximum values for the universal sets of input error change rate has 
the same value as the universal sets of input error ranging [-11] shown in Figure 5(B). In this figure it is seen 
that the membership functions in the universal sets consist of NS (negative small), Z (zero), and PS (positive 
small). While the minimum and maximum values for the universal sets of throttle thrust output can be 
calculated by equations 6 and 25. Because of the considerably small Coriolis Effect, the effect can be ignored 
so that the equation 25 is substituted into equation 6 to be as follows: 

w = g 4- 0)1 + oj% + 0 J 4 ) (36) 

The minimum value of thrust can be determined from equation (37) in order for quadrotor to be able 
to take off. The obtained equation is as the following: 

g — w = “^(<^1 + col + + mf) (37) 

When taking off, the fourth motors rotate at the same speed and the quadrotor has no starting acceleration, ”z 
= 0 thus the above equation becomes: 

2222 

(i)( = (jl>2 = M 3 = CO4 

^ = bw 2 

4 



where m = the quadrotor weight (4kg), g = the gravity (9.8), b = the moment of inertia for acceleration of z 
(1.3234e-005). From the calculation, it is obtained the value of the motor speed of 860 so that the minimum 
and maximum range values of universal sets of output speed can be set exceeding the value that is [-1000 
1000] shown in Figure 7. It is seen in the figure that the membership functions consist of NS (negative 
small), Z (zero), and PS (positive small). 



-1000 -300 -600 -400 -200 0 200 400 600 300 1000 

d utp ut va ria b le "5PEEET 


Figure 7. Output variable speed desain 


The design of the fuzzy rule base uses lookup table consisting of 9 rules to determine the decision. 
All rules are shown in Figure 8 connected with the AND operator. 
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Figure 8. Rule base 3x3 fuzzy mamdani altitude control 
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Figure 10 shows the design of fuzzy logic control system rules in which there are three algorithms to 
stabilize the quadrotor when hovering namely: 

1. The algorithm serves for a quadrotor to take off. 

2. This algorithm serves to dampen overshoot. 

3. This algorithm serves to dampen oscillations and head to the steady state. 

3.2. Attitude Control 

Figure 3(B) shows that the attitude control has six inputs that is errors of roll, pitch, and yaw, and 
the error change rate of roll, pitch, and yaw. Additionally, this control has three outputs namely thrust of roll, 
pitch and yaw to control the rotation of the four motors on the quadrotor. In this paper, the proposed control 
is fuzzy logic controller (FFC), meanwhile the algorithm can not control the system of multi input multi 
output (MIMO), therefore, the attitude control is made into three controls that is FFC of roll, pitch, and yaw 
as shown in Figure 9. 


\EH 



Figure 9. The proposed attitude control system 


Figure 9 shows that there are three fuzzy controls, namely fuzzy controls of roll, pitch and yaw. 
Fuzzy control of roll has two inputs that is roll error and change rate of roll error and an output thrust roll. 
Fuzzy control of pitch has two inputs that is pitch error and change rate of pitch error and an output thrust 
pitch. Fuzzy control has two inputs namely yaw error and change rate of yaw error and an output yaw thrust. 



(A* 


•iii 


Figure 10. Input variable (A) Error and (B) Dyaw design 


The proposed Attitude control uses fuzzy logic controller algorithm with rule base 3x3. The rule 
base is fuzzy control which the inputs and output have three membership functions with minimum and 
maximum values for the universal sets range of input errors of roll, pitch and yaw that can be calculated by 
using the equation 2.51, 2.52, and 2.53. In this paper, the universal sets of input error of roll, pitch and yaw 
have the same range [-0.3 0.3] and three membership functions as shown in Figure 10(A). The figure shows 
that the membership functions consist of NS (negative small), Z (zero), and PS (positive small). In this paper, 
the minimum and maximum range values for the universal sets of input error change rate of roll, pitch, and 
yaw have the same value as the universal sets of input error of roll, pitch and yaw that is [-1 1] as shown in 
Figure 10(B). The figure shows that the membership functions in the universal sets of error change rate 
consist of NS (negative small), Z (zero), and PS (positive small). 

The minimum and maximum values for the universal sets of output thrust of roll, pitch and yaw can 
be calculated with the equation 2.12 and 2.15 as the thrust throttle design. The output variables design for 
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fuzzy sets that will fit into quadrotor throtlle is shown in Figure 11. In this figure it is seen that the universal 
sets of output thrust of roll, pitch and yaw have a value range [-1000 1000] and the membership functions 
consist of NS (negative small), Z (zero), and PS (positive small). 



output variable "SPEED" 


Figure 11. Output variable Speed design 


The design of fuzzy rule base uses lookup table consisting of 9 rules to determine the decision. All 
rules shown in Figure 12 is connected with the AND operator. 
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Figure 12. Mamdani Attitude control with fuzzy rule base 3x3 


4. RESULT AND DISCUSSION 

In the simulation, the altitude and attitude controls using fuzzy logic controller was tested by 
Corke’s simulator (2011) which has a specification as shown in Table 1. The table shows that the quadrotor 
has a mass of 4 kg, the distance between the motor and the COG is 0.165 meters, the thrust constant is 
1,2953x10-5 kg.m, the drag constant is 1.0368 x 10 -7Kg.m, and tested on gravity acceleration of 9,8m / s2. 
To simulate the controls of attitude and altitude, the parameters contained in the simulator was previously set 
including setting the start position of the quadrotor at xy position (-1,0), the desired height of 1 meter, and the 
hover position of the quadrotor at xy (-1.0). 

The first experiment was conducted without wind disturbance. The simulation result of the hover of 
the quadrotor at z position with the height of 1 meter is shown in Figure 13(A). There are three graphs as 
seen in the figure namely set point, disturbance, and altitude. The fuzzy logic controller algorithm enables the 
altitude controller quickly stabilizes the quadrotor at 4.968 th second of the steady state and at 2.166 th second 
of the settling time. In addition, the quadrotor performs fast raise time to take off that is 1.607 second and 
there is no oscillation and overshoot in performing them.The hover position of the quadrotor remains 
unchanged ie equal to the initial position. 


Table 1. The Performance of Quadrotor 


Parameter 

Nilai 

Satuan 

Keterangan 

G 

9,81 

m/s 2 

Percepatan gravitasi 

M 

4,34 

Kg 

Massa A.R. Drone 2 

D 

0,165 

Meter 

Jarak antara rotor dengan COG 

B 

1,2953 x 10" 5 

Kg.m 

Konstanta gaya dorong 

K 

1,0368 x 10' 7 

Kg.m 

Konstanta gaya hambat 

lx 

0,082 

Kg.m 2 

Momen inersia sumbu x 

b 

0,0845 

Kg.m 2 

Momen inersia sumbu y 

Iz 

0,1377 

Kg.m 2 

Momen inersia sumbu z 
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(A) (B) 


Figure 13. Disturbance free relation graph of (A) altitude and (B) attitude 


Figure 13(B) shows that when hovering, attitude control of the quadrotor is able to stabilize roll, roll 
acceleration, pitch, pitch acceleration, yaw, and yaw acceleration. From the graph it appears that there is no 
disturbance and oscillation on roll, roll acceleration, pitch, pitch acceleration, yaw, and yaw acceleration 
when the quadrotor take off and hover. 

In the second simulation, experiments was performed by using wind-like disturbance as the 
quadrotor hovers at Z position with a height of 1 meter shown in Figure 14(A). It can be seen from the figure 
that there are set point, disturbance, and altitude. When hovering, the quadrotor was disturbed at 15 th second 
for 3 seconds. It makes the quadrotor’s height changes to 1.4 meters. Altitude Controller quickly stabilizes 
the quadrotor and returns it to the initial position with raise time of 1.607 seconds, steady state at 4.968 th 
second and setling time at 2.166 th second. 




Figure 14. Graph of (A) altitude and (B) attitude with disturbance when hovering 


Figure 14(A) shows that when the quadrotor takes-off and hovers, it is disturbed by vertical wind, so 
that its altitude changes. With the position change, the quadrotor attitude controller maintains the stability of 
roll, roll acceleration, pitch, pitch acceleration, yaw, and yaw acceleration as shown in Figure 14(B). it is 
seen from the figure that there is no noise and oscillation on roll, roll acceleration, pitch, pitch acceleration, 
yaw, and yaw acceleration when the quadrotor is disturbed when it takes off and hovers. 


5. CONCLUSION 

This paper presents the development of quadrotor control using fuzzy logic algorithms. This control 
is used to stabilize the quadrotor when it takes-off, lands, and hover. There are two controls to stabilize the 
current position quadrotor hover. The main control in this paper is the altitude control which serves to control 
the height position of the quadrotor when it hovers. Therefore, the control is capable of stabilizing the 
quadrotor in condition there is disturbance of vertical wind. The weakness of this control is that it can not 
stabilize the angular accelerations of the roll, pitch and yaw when hovering. So that control of the second in 
this paper is an attitude control to adjust the roll, pitch and yaw. The controls performs fast time raise, settling 
time, steady state, and there is no overshoot. 


Hovering Control of Quadrotor Based on Fuzzy Logic (Nia Maharani Raharja) 
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